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1. INTRODUCTION 

In navigation and localization [1, 2], a long baseline (LBL) acoustic positioning system serves as 
position reference in the water. This is much similar to the role of the global positioning systems (GPS) in the 
terrestrial and aerial applications. In this sense, position of a navigation subject is computed based on a set of 
ranges between each acoustic transponder and the subject. Each range is obtained by measuring traveling time 
of an acoustic wave from the transponder in question to the subject, either in a two-way travel time (TWTT) 
or one-way travel-time (OWTT) configuration [3]. The acquired time multiplied by propagation speed of the 
wave. This method is commonly termed as time-of-flight (ToF) [4] measurement. 

As implied by the above description, there are several prerequisites for an ideal ToF. First, the wave in 
question must travel in a line-of-sight (LoS). Second, the measurement points are at stationary positions during 
the ToF. Third, the clocks used in recording send and receive times must be in agreement with a shared refer- 
ence, e.g. the absolute clock. For an individual clock, this synchronization issue is related to time, frequency, 
and phase [5]. 

If one of the aforementioned conditions does not hold, the ToF will result in a pseudorange, 1.e. 
a biased range. A ToF with non-LoS condition may occur both in electromagnetic [6] and underwater 
acoustic [7, 8] waves. On the other hand, the case of non-stationary measurement point may arise only in 
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acoustic based ToFs. This is due to the wave’s slow propagation speed [9]. Some scenarios related to this 
problem have been addressed in the literature, e.g. queuing ToFs [10-12] and moving navigation subject with 
non-negligible speed [13, 14]. 

Meanwhile, a divergence to the third condition would introduce clock-offset to the ToF. Since wave 
speed (~ 1500 m/s) is the multiplying factor in a ToF, the presence of even a minuscule offset would propagate 
a noticeable bias to the pseudorange. In one recent literature [15], this problem has been carried out in an 
elegant state-space formulation with some promising results. This problem is also brought up in [13] along 
with the non-stationary ToF measurement. In both aforementioned works, the clock-offset is considered as 
a constant. Nonetheless, for a common clock with quartz oscillator, its decreasing performance is partly due 
to aging, temperature, pressure, and humidity [16, 17]. In this sense, an existing clock-offset will deteriorate 
further over the time and worsen the pseudorange. Therefore, it becomes reasonable to consider clock-offset 
compensation as a time-varying case. 

The main contribution of this paper is to propose compensation of the time-varying clock-offset in a 
LBL navigation. Specifically, the clock-offset dynamics are introduced to the ToFs as an autoregressive filter. 
Subsequently, interactions among the now biased ToFs and the kinematics of an autonomous underwater vehi- 
cle (AUV)-the navigation subject—are represented in a state-space form. Implementing the so-called graphic 
approach, minimum sensor requirement for this system’s observability is then explicated. Finally, a standard 
discrete Kalman filter is deployed as the state estimator. In this paper, I and O denote identity matrix and zero 
vector, respectively. Their dimensions would vary according to the usage. 


2. PROBLEM STATEMENT 

Consider a LBL formed by L acoustic transponders with known position, i.e. r1,..., rz € R, as 
shown in Figure 1. To mitigate the vertical dilution of precision (V-DOP) [18], one of the transponders is 
installed below a static vessel. Through a certain calibration procedure [19], the transponders’ actual positions 
are in alignment with their nominal ones. An autonomous underwater vehicle (AUV) moves inside the baseline 
with a constant speed. At time t, each transponder sends an acoustic wave to the AUV receiver in a OWTT 
configuration. Once all the ToFs complete, the AUV used the pseudoranges to estimate its position and velocity 
at t, i.e. r(t) € RÌ and v(t) € RÌ, respectively. Due to the factors mentioned earlier, clocks of the transponders 
suffer from clock-offsets and this in turn affects the localization accuracy. 





Figure 1. A LBL navigation involving L transponders and an AUV 


The above scenario holds on to the following assumptions. First, each signal carries encoded 
information about its send time and the transponder’s identity [20]. Second, waves transmitted by transponders 
travel in LoS with constant speed. Third, all transponders’ dynamics are identical. Fourth, the AUV clock is 
synchronous with the actual/absolute clock. 


2.1. Sampling period and time 

Since transponder has a certain update rate [21], it follows that a ToF measurement would take place 
every period of time. Therefore, it is of interest to describe dynamics involving the LBL and AUV in a discrete 
form. Accordingly, it may be defined that: 
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b= Khe 


where T > 0 and k € N denote sampling period and time index, respectively. Noticing that a ToF is initiated 
from transponder, it would then be sensible to take 7 as the transponders’ update rate. 


2.2. Vehicle kinematics 
The AUV position at k can then be modeled as: 


r(k+1)=r(k)+rTv(k), (1) 
while subsequently its velocity can be written as: 
veren (2) 
recalling that the AUV moves in a constant speed. 


2.3. Pseudorange and time-varying clock-offset 
A ToF measurement between transponder j (j = 1,..., L) and the AUV at k will result in: 


le(k) = r;|| = c[t;(k) — to(k)] (3) 


where c denotes the acoustic wave speed, while to(/) and t,;(k) are send and receive times of the wave 
transmitted by transponder j at k, respectively. One should notice that to(k) would be identical for all 
transponders following the third assumption. Introducing uncertainties into the ToF measurement while 
defining d;(k) := c|t;(k) — to(k)], an expression for pseudorange based on (3) can now be written as: 


d;(k) = |[r(k) — rj|| + O(K) + 65(%), (4) 


where 6(k) denotes clock-offset in the transponder while 6;(/) represents uncertainty due to the AUV 
movement during the ToF. For further elaboration about 4,;(k), the reader may consult [13] or the authors’ 
previous work [14]. If the clock of transponder j continues to drift from the reference clock, then 6(k) in (4) 
would also evolve over the time. For this time-varying case, 6(k) can be stated as: 


0(k +1) = 0(k) + ra(k) + w(k), (5) 


where T. > 0, a(k), and w(k) denote the clock-offset sampling period, clock-skew, i.e. instantaneous clock- 
drift rate [22, p. 7] and clock-offset’s additional noise, respectively. Borrowing an approach developed in the 
wireless network community [23], a clock-skew is modeled as an autoregressive (AR) filter, 1.e.: 


a(m) = ys amalm — 1) +n(m), (6) 


where P and am denote the AR’s order and coefficient at m*” order, respectively, while n(m) represents an 
additional noise. 


2.4. States definition 
To obtain a state-space representation of the modeled system, it is defined that: 


r(k):= xı (k), vk) t= xi(k),. 0(k):= z3(k), alm) := z4(k), =- alm -— P) := z44p(k), 


noticing that the Pt” order AR filter in (6) is now represented by P state variables at k. Accordingly, (1)-(2) 
can be written respectively as: 
x1(k +1) = x1(k) + Tx2(k), (7) 


and: 
x(k + 1) = x2(k). (8) 
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Furthermore, (5) can be written as: 


£3(k + 1) = z4(k) + Teza (k) + w(k), (9) 
while (6) can now be stated as: 
zalk +1) = aı£4(k) + azz5(k) +... +apzz+p(k)+n(k) 
. (10) 


ta¢P(k+1) = z3+p(k) 


2.5. Pseudorange differences and additional states 

It is desirable to get and explicit relation between d;(k) and x,(k) in (4). For this purpose, 
the so-called pseudorange difference approach [24] is to be implemented. The idea is to derive a difference 
between two pseudoranges, i.e. d;(k) and d;(k) based on (4), where i = 1,... L but i # j. Much similar to 
the derivation steps in [15] and [25], carrying out mathematical manipulations on (4) leads to: 


dj(k) 


rj) 
a0 eee 1a g“) 
[di(k + 1) — di(k)] — |d; (k + 1) - d;(k)| 
dilk +1)+d;(k +1) 


((di(k +1) —d,;(k+1)) E 
+ Ue ee EARL) + ri k), (11) 


di; (k 


di(k +1) —di(k-+1) = GS 
( 


ae 
a 
rp 


+ 2c x3(k) 


where A;;(k) represents all noises involved in the pseudorange difference derivation. To include all ToFs into 
the system’s representation, it is defined based on (11) that: 


di(k) — do(k) = 254p(k), di(k) — d3(k) :=ae4p(k), «++, dr-ı(k)— dr := z4+p+u(k), (12) 
where U = L(L — 1)/2 is the number of possible combinations of pseudorange-differences derived 
from L ToFs. 


2.6. State-space representation 
Incorporating (7)-(10 ) and (12), the state vector can now be defined as: 


S= | Xı(k) xə(k) a3(k) wa(k) +- xapp(k) + taypyu(k) jg = ROPO EIRRRU. 


and subsequently the state-state space equations can now be written as: 


x(k +1) = A(k)x(k) + w(k) (13) 
y(k+1) = Cx(k +1) 
where 
I TI 0 0 0 
0 I 0 0 0 
A(k) = | 0 0 1 hes 0 c ROH3HIHPHU)x(3+3+1+P+U) 
0 0 0 A44 0 
O Aso(k) Ass(k) Asa(k) Ass(k) 


A234 = | Te 0 «--:- 0 | ERED. 
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Area Ret D+ ager) 
A44 = . E R?*?, Aso(k) = 77 ; < Re, 
00 1 0 — Tat 
dp-1(k+1)+dz(k +1) 
[di (& + 1) — di(k)| — [do(k + 1) — do(’)) 
di(k +1) +d2(k+1) 
A53(k) = . € RY, 
ldp_(k +1) — dp_(k)] — [dx (k + 1) -— dr(k)] 
dpi(k+1)+dzr(k+1) 
[dx(k +1) — di(k)] ~[da(kK+1)—a(k)}) 9 
dy(k+1)+do(k+1) 
As5a(k) = CT ; E ROEN. 
dr-(k+1)-dr-(k)]- [drk tD- dL o o 
dr—ı(k+1)+dzr(k+1) 
ape dı (k) + d2(k) dr-1ı(k) + dzr(k) x 
Ass(k) = dias ( a a E ae) ) SR 
and 
w(k)=|0 0 w(k) n(k) 0 >- 0 Alk) +++ Aq-nrlk) le ER reer ae 


On the other hand, the output part of (13), i.e. vector y(k) and matrix C are to be addressed separately in the 
next subsection. 


2.7. Observability analysis and minimum sensor requirement 

To become applicable for state estimation, it is a necessary that (13) observable. To examine the 
system’s observability, the so-called graphic approach [26] is implemented. Here, an inference diagram is to 
be constructed by applying the following steps. The first step is to draw a node for each state variable in (13) 
while excluding the sampling index k. The second step—for each state equation— is to draw an arrow from state 
appearing at the left side directed to each state at the right. Results of these steps are shown in Figure 2. 

The observability of a state variable is then checked using the following inspection routine on its 
representing node in Figure 2. First, if there is any incoming arrow towards the node, then it would be is 
assigned as a non-sensor node. Second, if there is no incoming arrow towards the node, then it would be 
assigned as a sensor node. In this sense, nodes x; and %54p~p, ..., %54+p4u are assigned as sensor nodes. 
It means that deploying sensors is the only way to gather information about their respective states in (13). 
On the other hand, information about a state represented by a non-sensor node can be inferred from other 
state(s). In the sense of minimum requirement, this implies that measurement on a non-sensor state would not 
be a necessary for the system’s observability. 

Figure 2 seems to suggest that the observability of (13) requires U-+1 sensor nodes. However, it should 
be recalled that 75, p(k), ..., %54p+u(k) states are formed by L ToFs measurements to decipher relationship 
between ToFs and x;(k) in (4). This means that once L ToFs are available, x;(k) can be observed through 
(12) . Hence, the system actually only requires L sensors to be observable and the output matrix can be written 
as: 


Csi o 0: 0c OF Lise Re eater rr), 


i.e. the output vector would only consist the pseudorange difference states. 
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sensor node 





non-sensor node 


Figure 2. An inference diagram representation of (13) 


2.8. Proposed solution 
Considering that (13) is a linear system and all noises are modeled as Gaussian, a standard discrete 
Kalman filter [27] is to be implemented as the state estimator. 


3. SIMULATION AND RESULTS 
3.1. Setup 

In this simulation, a LBL with five transponders is to be considered. The transponders’ position are 
r=[0 0 0] mrp=[0 0 101] mr3z =[ 1600 0 100] m,r4=[0 1600 10] m, 
and ro =| 1600 1600 99 i m. Here, it is assumed that c = 1500 m/s, while the LBL of choice is a low 
update rate type, 1.e. 0.1 Hz [21]. In accordance to this rate, 7 1s set to be 10 s. 

Numerical values related to the clock dynamics are taken from [23], i.e. Te =900 s, P = 5, and: 


| âi +- ds | =| 0.9271 0.4613 0.07483 —0.387 —0.03118 ], 


where G1,--- ,@s5 are the estimated values of a1,--- ,a5, respectively. Similar to [15], the initial value of the 
clock offset is set to be 0.3s that would equal to 45 m deviation of a pseudorange. 

The AUV is deployed to follow a helix trajectory with radius 250 m as shown in Figure 3. AUV starts 
from r(1) =[ 949.47 707.852 5.085 ]° m with respective speed v(1) =[ —0.0246 0.785 0.0085 |” 


m/s and is expected to finish at r(1000) = | 950 700 65 | 1 m. The considerable large numbers of sampling 
is chosen to accommodate the evolution of 0(k) and a(k). At the estimator, initial values for the position and 


speed are set to be r(0) =| 950 700 5 |“ mand y(0)=| 0 0 0 | m/s, respectively. 


actual 
estimated 


z [m] 








70-4 FINISH _ ae 00 
S00 e o -ggg 700 x [m] 
y [m] 


Figure 3. The AUV trajectory 


3.2. Results and discussion 

The simulation results are presented in terms of t instead of k where 1000 samplings would be 
equivalent to 10000 s. In Figure 3, it is shown that the estimator can tracks the AUV actual position. 
A closer look on this particular result is presented in Figure 4 (a). In xyz axis, it is shown that good accuracy 
are achieved during the trajectory tracking. On the other hand, a good result in velocity estimation is also the 
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case as shown in Figure 4 (b). Regarding to the error profiles in Figure 4, it is worth to recall that the AUV 
velocities in x and y are not linear for a helix trajectory. 

The above results indicate that the estimator manages to compensate the clock’s biases. As shown in 
Figure 5 (a), the initially large clock-offset rapidly converges. Recalling the mathematical expression in (5), 
this convergence is also a result of the clock-skew’s compensation. As shown in Figure 5 (b), the clock-skew 
also converges over the time in a rather similar manner to the clock-offset. 

















position errors [m] 
velocity error [m/s] 











0 2 000 4 000 6 000 8 000 10 000 0 2 000 4 000 6 000 8 000 10 000 


time |s] time [s] 
(a) (b) 


Figure 4. Estimation errors of the AUV kinematics in xyz axes, (a) position errors, (b) velocity errors 











| -Se-06 | 
0 2 000 4 000 6 000 8 000 10 000 0 2 000 4 000 6 000 8 000 10 000 
time [s] time [s] 
(a) (b) 


Figure 5. Compensation of the clock’s biases, (a) clock offset, (b) clock skew 


~ 


EET ; > E -~ qT 
Furthermore, the estimation performances are presented in Table 1. Here, r =| Te Ty Ve 


9 


~ 


V = Ce Uy Vz |”, 0, and a denote the estimated position, velocity, clock-offset, and clock-skew, 
respectively. Their respective averaged standard of deviation values are obtained through repeating the simula- 
tion procedure for more than 1000 times. It 1s shown that the estimator can provide position localization with 
accuracy less than 1 m. 


Table 1. Estimation performances. 
Estimated Variable Averaged standard of deviation 


| õe fy fe | [ 33-107? 9.7-107? 8.63-107° |m 
| te ty õ | | 230-107? 1.05-107? 4.49.1077? | m/s 


1.6 - 107? s 
6.51 - 1074 s/s 


Q D 
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4. CONCLUSION 


Compensation of clock-offset in a LBL navigation was presented in this paper. Its main contribution 
was to deal with the offset as a time-varying case by represent its dynamics as an AR filter. By simulation, 
it was demonstrated that the estimator manage to compensate the offset while provide localization to the AUV 
with less than 1 m accuracy. 
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